INTEGRATION  OF  A  STAR  TRACKER  AND  INERTIAL  SENSORS  USING  AN 

ATTITUDE  UPDATE 


THESIS 

SEPTEMBER  2014 


Humood  Alkhaldi,  Captain,  RSAF 
AFIT-ENG-T-I4-S-I6 


DEPARTMENT  OF  THE  AIR  FORCE 
AIR  UNIVERSITY 

AIR  FORCE  INSTITUTE  OF  TECHNOLOGY 


Wright-Patterson  Air  Force  Base,  Ohio 


DISTRIBUTION  STATEMENT  A. 

APPROVED  FOR  PUBLIC  RELEASE;  DISTRIBUTION  UNLIMITED. 


The  views  expressed  in  this  thesis  are  those  of  the  author  and  do  not  reflect  the  official 
policy  or  position  of  the  United  States  Air  Force,  Department  of  Defense,  or  the  United 
States  Government.  This  material  is  declared  a  work  of  the  U.S.  Government  and  is  not 
subject  to  copyright  protection  in  the  United  States. 


AFIT-ENG-T-14-S-16 


INTEGRATION  OE  A  STAR  TRACKER  AND  INERTIAL  SENSORS  USING  AN 

ATTITUDE  UPDATE 

THESIS 

Presented  to  the  Eaeulty 

Department  of  Electrieal  and  Computer  Engineering 
Graduate  School  of  Engineering  and  Management 
Air  Eorce  Institute  of  Technology 
Air  University 

Air  Education  and  Training  Command 
In  Partial  Eulfillment  of  the  Requirements  for  the 
Degree  of  Master  of  Science  in  Electrical  Engineering 

Humood  Alkhaldi,  BS 
Captain,  RSAF 

September  2014 


DISTRIBUTION  STATEMENT  A. 

APPROVED  EOR  PUBLIC  RELEASE;  DISTRIBUTION  UNLIMITED. 


AFIT-ENG-T-14-S-16 


INTEGRATION  OE  A  STAR  TRACKER  AND  INERTIAL  SENSORS  USING  AN 

ATTITUDE  UPDATE 


Humood  Alkhaldi,  BS 
Captain,  RSAF 


Approved: 

_ //signed// _  19  Aug,  2014 

John  F.  Raquet,  PhD  (Chairman)  Date 

_ //signed// _  19  Aug,  2014 

Meir  Paehter,  PhD  (Member)  Date 

_ //signed// _  19  Aug,  2014 

Kyle  Kauffman,  PhD  (Member)  Date 


AFIT-ENG-T-14-S-16 


Abstract 

The  Global  Positioning  System  (GPS)  is  widely  used  in  most  of  the  military  and 
civilian  applications  because  of  its  precision  navigation  capability.  Unfortunately,  GPS  is 
not  available  in  all  environments  (e.g.,  indoors,  under  sea,  underground,  or  jamming 
environment).  The  motivation  of  this  research  is  to  address  the  limitations  of  GPS  by 
using  star  trackers  as  an  attitude  update  to  an  inertial  navigation  system  (INS). 
Commercial,  tactical,  and  navigation  grade  INS  are  modeled  and  simulated  with 
measurements  from  GPS,  star  tracker,  and  barometer.  GPS  measurements  are  used  to 
update  the  INS  position  and  velocity  for  a  small  duration  in  the  beginning  of  the  vehicle’s 
flight  time.  Star  tracker  and  barometer  measurements  are  used  to  update  the  INS  attitude 
and  altitude,  respectively.  This  research  uses  a  Linear  Kalman  Filter  as  a  recursive 
estimation  system,  to  estimate  the  INS  errors  (i.e.  position,  velocity,  tilts,  accelerometer 
bias,  gyroscope  bias,  and  barometer  bias)  using  the  three  types  of  measurement  updates. 
The  simulation  results  show  that  the  star  tracker  was  able  to  improve  the  performance  of 
the  commercial  and  tactical  grades  INS,  for  any  duration  of  the  vehicle’s  flight  time. 
Also,  the  improvement  in  the  performance  of  the  navigation  grade  INS  was  not 
significant  until  the  vehicle’s  flight  time  was  more  than  approximately  1000  seconds. 
Also,  the  research  shows  the  performance  impact  on  the  three  INS  grades  when  using 
different  star  tracker  accuracies. 
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INTEGRATION  OF  A  STAR  TRACKER  AND  INERTIAL  SENSORS  USING  AN 

ATTITUDE  UPDATE 


I.  Introduction 

This  thesis  outlines  a  researeh  effort  to  integrate  star  trackers  with  inertial  sensors 
for  self-contained,  robust,  autonomous  navigation.  This  research  is  motivated  by 
the  requirement  for  self-contained  navigation  in  environments  where  the  Global 
Positioning  System  is  unavailable. 

Navigation  precision  is  the  cornerstone  of  combat  operations  success  in  modern 
wars.  The  Global  Positioning  System  (GPS)  was  developed  in  1973  for  more  accurate 
and  precise  navigation  capabilities  than  the  old  navigation  systems.  In  the  Gulf  War,  GPS 
was  used  for  the  first  time  for  precision  navigation  in  combat  [15].  The  precision  of  the 
Guided-GPS  missiles  and  the  precise  aircraft  navigation  used  in  the  war,  made  a  huge 
rule  in  controlling  the  war  and  furthermore  successes  for  the  coalition  forces.  Thus, 
precision  of  navigation  is  an  important  factor  in  all  military  operations  and  especially  the 
Air  Force,  and  it  cannot  be  achieved  in  areas  where  GPS  signals  are  not  available  (e.g., 
underwater,  under  trees,  beside  mountains  or  in  jamming  environments). 

The  motivation  of  this  research  is  to  address  the  limitations  of  the  current 
navigation  methods  by  using  star  trackers  and  inertial  systems.  This  concept  is  inspired 
from  the  Noble  Qur’an.  Allah  said  “And  it  is  He  who  placed  for  you  the  stars  that  you 
may  be  guided  by  them  through  the  darknesses  of  the  land  and  sea.  We  have  detailed  the 
signs  for  a  people  who  know”  [16].  Stars  were  explained  in  the  Noble  Qur’an  to  be  used 
to  guide  people,  and  it  is  been  used  from  the  beginning  of  human  until  the  modern 
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century.  With  the  new  teehnology  and  the  development  of  eleetronies,  star  traekers  ean 
be  advaneed  and  enhaneed  with  new  navigation  methods  to  be  used  with  the  inertial 
sensors  for  preeise  navigation. 

The  following  seetions  will  explain  the  problem  definition  of  the  researeh,  the 
eontributions  to  the  researeh  area,  and  the  outline  of  the  researeh  ehapters. 


1.1  Problem  Definition 

Considering  the  unreliability  of  GPS,  as  it  ean  be  denied  through  external 
interferenee,  it  is  important  to  eonsider  different  navigation  systems.  An  inertial 
navigation  system  (INS)  eombined  with  a  Celestial  Navigation  System  (CNS)  ean 
enhanee  the  aecuraey  of  navigating,  by  using  star  trackers  mounted  on  the  aireraft  to 
eorreet  the  aeeumulated  errors  in  the  INS. 

Celestial  navigation  system  primary  eonsists  of  a  star  traeker  mounted  on  a 
navigating  vehiele  (e.g.  aireraft,  spaeeeraft,  ship,  and  missile)  that  eapture  stars  available 
in  the  field  of  view  of  the  star  traeker  eamera  and  then  compare  it  with  a  star  catalogue 
saved  in  the  vehiele  eomputer.  From  this  proeess,  the  vehiele’s  attitude  ean  be  estimated 
and  then  used  to  aid  the  INS  as  an  attitude  update. 

This  researeh  will  simulate  the  star  traekers  when  integrated  with  different 
qualities  of  INS,  and  show  the  impact  and  improvement  to  the  navigating  vehiele. 
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1.2  Research  Contributions 


As  mentioned  in  the  previous  seetion,  the  objective  of  this  research  is  to  simulate 
and  show  the  advantage  of  star  trackers  when  used  to  aid  different  grades  of  the  INS. 

There  are  three  primary  contributions  in  the  research.  The  first  contribution  is  to 
model  the  different  grades  of  the  INS  (i.e.  commercial,  tactical,  and  navigation),  and  that 
is  described  in  Chapter  III,  Section  3.2. 

The  second  contribution  is  to  model  different  aiding  measurements,  which  will  be 
the  star  tracker  model,  GPS,  and  barometer.  The  GPS  model  will  be  shown  and  explained 
in  Chapter  III,  Section  3.4.1.  The  barometer  model  will  be  explained  in  Chapter  III, 
Section  3.4.2.  Finally,  the  star  tracker  model  will  be  explained  in  Chapter  III,  Section 

3.4.3. 

The  third  contribution  is  to  simulate  the  previous  models  in  MATLAB,  using 
Kalman  filter  as  an  estimator,  to  show  the  performance  development  to  the  different 
grades  of  INS. 


1.3  Thesis  Outline 

This  research  is  organized  as  follows.  Chapter  II  will  provides  a  mathematical 
background  for  reference  frames,  transformation  between  reference  frames,  star  tracker 
concepts  and  specifications,  linear  and  nonlinear  Kalman  filter  estimators,  and  previous 
work  in  the  field  of  celestial  navigation.  Chapter  III  will  presents  the  methodology  used 
in  the  research  and  the  models  developed.  Chapter  IV  will  show  the  simulation  results  of 
the  developed  methodology  and  the  impact  of  star  tracker  accuracy  on  the  different 
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grades  of  INS.  Finally,  Chapter  V  will  conclude  the  research  results  and  provide 


recommendations  for  future  work  related  to  the 


research. 
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II.  Mathematical  Background 


^  I  ''his  chapter  reviews  the  mathematical  background  materials  that  are  required  to 
understand  the  methodology  used  to  aid  the  inertial  navigation  system  using 
eelestial  observations.  The  chapter  begins  with  introduction  to  the  inertial  navigation 
system.  Next,  the  reference  frames  used  in  navigation  are  defined  and  the  transformation 
of  eoordinates  between  reference  frames  is  explained.  Then,  the  WGS-84  eoordinate 
system  is  reviewed.  Next,  star  trackers  are  introduced  along  with  their  speeifications.  In 
addition,  a  discussion  of  the  Kalman  filter  is  presented  as  a  widely  used  recursive 
estimation  system.  Finally,  previous  work  related  to  this  researeh  is  discussed. 

2.1  Inertial  Navigation  System 

The  Inertial  Navigation  System  (INS)  is  a  navigation  system  that  uses  two  types 
of  sensors  and  a  proeessing  computer  to  ealculate  the  position,  veloeity  and  attitude  of  a 
vehiele.  There  are  two  types  of  sensors  used,  aeeelerometers  and  gyroseopes  [2].  An 
aecelerometer  is  a  motion  sensor  that  measures  the  specific  force  of  a  vehicle,  and  the 
gyroscope  is  a  rotation  sensor  that  measures  the  angular  veloeity  of  a  vehicle  [2]. 

There  are  two  types  of  INS,  gimbaled  and  strapdown,  and  the  Strapdown  Inertial 
Navigation  System  (SINS)  will  be  used  in  the  research.  In  the  strapdown  inertial 
navigation  system,  the  aeeelerometers  and  gyroscopes  are  directly  mounted  on  the 
vehicle  body  [2].  A  diagram  that  explains  the  meehanism  of  the  SINS  is  shown  in  Fig. 
2.1. 
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Initial  conditions 


Initial  conditions  position 


Figure  2.1:  Strapdown  Inertial  Navigation  System  (SINS)  diagram  [10] 


In  Fig.  2.1,  the  measurements  of  the  body  angular  rate  (o>^)  and  speeific  force 
(f^)  are  the  main  inputs  to  the  SINS,  and  they  are  ealeulated  by  using  gyroseopes  and 
aeeelerometers  respeetively.  Also,  the  is  ealled  the  Direetion  Cosine  Matrix  (DCM) 
and  it  will  be  explained  in  the  following  seetion. 


2,2  Direction  Cosine  Matrix 

The  direction  cosine  matrix  is  a  3x3  matrix,  used  to  transform  a  veetor  or  a 
matrix  from  one  referenee  frame  to  another  eoordinate  frame  using  eosine  of  the  angles 
between  the  two  frames  [2]. 
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A  transformation  from  body  frame  to  navigation  frame  is  denoted  by  C^,  whieh 
ean  be  ealeulated  by  three  rotations  about  different  axes  as  expressed  in  the  following 
equation 


COS  6  cost/; 
COS0  sint/t 
— sin0 


— COS0  sin0 
+sin0  sin0  cos0 

COS0  COS0 
+sin0  sin0  sin0 

sin0  COS0 


sin0  sin0 
+COS0  sin0  COS0 

— sin0  COS0 
+COS0  sin0  sin0 

COS0  COS0 


(2.1) 


where  0  (yaw)  is  the  rotation  angle  about  z-axis,  6  (piteh)  is  the  rotation  angle  about  y- 
axis  and  0  (roll)  is  the  rotation  angle  about  x-axis  [2], 

Also  the  DCM  to  transform  from  navigation  frame  to  body  frame  is  simply  the 
transpose  of  the  previous  equation,  i.e.,  . 


2,3  Reference  Frames 

For  navigating  on  the  earth,  it  is  important  to  define  a  number  of  referenee  frames 
to  represent  the  inertial  measurements  in  the  eardinal  direetions  of  the  earth.  Eaeh  one  of 
the  referenee  frames  is  a  right  handed,  orthogonal  eo-ordinate  frame  [2].  A  list  of  the 
most  used  referenee  frames  is  shown  below: 

•  The  Earth-eentered  inertial  frame  {i-frame) 

•  The  Earth-eentered  Earth-fixed  frame  {e-frame) 

•  The  navigation  frame  (n-frame) 

•  The  body  frame  (b-frame) 
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The  sensor  frame  (s-frame) 


Eaeh  of  the  frames  is  deseribed  in  the  following  subseetions. 


2. 3. 1  Earth-Centered  Inertial  Frame  (i-frame) 

The  Earth-eentered  inertial  frame  has  its  origin  at  the  eenter  of  the  earth  and  its 

axes  {x\ y'-  and  z‘)  are  non-rotating  with  respeet  to  the  fixed  stars  [2],  see  Eig.  2.2  for 
axes  illustration. 


2. 3. 2  Earth-Centered  Earth-Fixed  Frame  ( e-frame) 

The  Earth-eentered  Earth-fixed  frame  has  its  origin  at  the  eenter  of  the  earth  and 

its  axes  are  fixed  with  respeet  to  the  earth.  Its  axes  are  defined  by  x®,y®  and  z®.  The  x® 
axis  lies  along  the  interseetion  of  the  plane  of  the  Greenwieh  meridian  and  the  earth’s 
equatorial  plane,  the  z®  axis  is  aligned  with  the  North  Pole  and  the  y®  axis  is 
perpendieular  to  x®andz®  with  a  direetion  that  follows  the  right  hand  rule.  The  Earth- 
eentered  Earth-fixed  frame  rotates  with  respect  to  the  inertial  frame,  at  a  rate  of  rOjg  about 
the  z®  axis  [2].  See  Eig.  2.2  which  includes  an  illustration  of  the  e-frame  axes. 


2.3.3  Navigation  Frame  (n-frame) 

The  navigation  frame  is  denoted  by  n  and  has  its  origin  at  the  location  of  the 
navigation  system.  Its  axes  are  aligned  with  the  directions  of  north,  east,  and  local 
vertical  (down),  defined  by  x^,y^andz^  respectively  in  Eig.  2.2.  The  turn  rate  of  the 
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navigation  frame  in  relation  to  the  earth  fixed  frame  is  determined  by  the  motion  of  the 
frame’s  origin  with  respect  to  the  earth  [2],  see  Fig.  2.2. 


Figure  2.2:  Illustration  of  Earth-centered  inertial,  Earth-centered  Earth-fixed  and 

Navigation  frames  [1] 


2.3.4  Body  Frame  (b-frame) 

The  body  frame  has  its  origin  at  the  center  of  the  vehicle’s  body.  The  orthogonal 
axes  of  the  body  frame  are  aligned  with  the  roll,  pitch  and  yaw  axes  of  the  vehicle  in 
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which  the  navigation  system  is  installed,  defined  as  x^,y^  and  z^,  respectively  [2].  Fig. 
2.3  shows  the  axes  of  the  body  frame  with  their  corresponding  rotations. 


Figure  2.3:  Illustration  of  the  body  frame  [1] 


2.3.5  Sensor  Frame  (s-frame) 

The  sensor  frame  can  be  designed  in  any  way  the  sensor’s  designer  likes,  by 
determining  the  axes  and  origin.  Its  axes  should  be  right  handed  and  orthogonal  and  in 
order  for  the  sensor  frame  to  be  useful,  the  relationship  between  the  sensor  and  body 
frames  must  be  known.  Fig.  2.4  demonstrates  a  sensor  frame  with  axes  denoted  by  x^,y^ 
and  z^. 
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Figure  2.4:  Illustration  of  the  sensor  frame 


2,4  The  WGS-84  Coordinate  System 

The  World  Geodetic  System  (WGS)  is  a  system  used  to  refer  to  all  terrestrial 

locations  in  a  convenient  manner.  The  system  mainly  helps  in  navigation,  geodesy  and 
cartography  [2].  It  is  important  to  note  that  the  WGS-84  coordinate  system  is  right 
handed,  and  major  parameters  used  in  WGS-84  are  shown  in  Table  2.1 
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Table  2. 1 ;  Key  WGS-84  parameters  [2] 


Parameter  (Sample) 

Value  (Units) 

Semi-major  axis  (a) 

6378137  m 

Flattening  of  the  ellipsoid  (/) 

1/298.257223563 

Angular  velocity  (©) 

7.292115  X  10“^  rad/s 

Geocentric  gravitational  constant  {GM) 

398600.5  /cmVs^ 

2,5  Star  Trackers 

Star  traekers  use  star  catalogs  to  measure  the  attitude  information  of  a  vehicle  in 
the  vehicle  coordinate  frame  by  comparing  the  angles  of  the  captured  star  with  the  star 
catalog  that  it  has  [9]. 

Star  trackers  are  extremely  accurate  sensors  for  attitude  sensing  and  there  are 
different  types  of  star  trackers: 

•  Star  scanners 

•  Gimbaled  star  trackers 

•  Fixed  head  star  trackers 

Star  scanners  provide  the  searching  and  sensing  function  using  the  vehicle 
rotation  [9].  Gimbaled  star  trackers  use  mechanical  action  to  search  out  and  acquire  stars 
and  the  fixed  head  star  trackers  use  an  electronic  searching  and  tracking  capabilities  over 
a  limited  field  of  view  to  track  stars  [9].  A  comparison  of  attitude  sensors  is  shown  in 
Table  2.2. 
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Table  2.2:  Comparison  of  attitude  sensors  [9] 


Sensor 

Num. 

Axes 

Operating  Angular 
Range 

Orbits 

Size/Mass/ 

Power/Cost 

Accuracy/ 
Angular  Rate 

Earth  Sensor 

2 

Narrow: 

Nadir  ±  ~10“ 

Circ.,  small 
alt.  range 

Medium 

Medium/ 

High 

Sun  Sensor 

2 

Narrow:  Sun  ±  ~30° 
None  in  eclipse 

Any 

Low 

Low/ 

High 

Magnetometer 

2 

Full  sphere,  but  need 
magnetic  clean  sat. 

LEO  only 

Low 

Low/ 

High 

Available  GPS 
Attitude  Receivers 

3 

Medium: 

Zenith  ±  -90° 

Alt  <  10k  km 
No  GEO 

Medium 

Medium/ 

High 

Available  Star 

T  rackers 

3 

Wide:  All  except 
Earth/Sun 

Any 

High 

High/ 

Low 

New  Opportunity 
Star  Tracker 

3 

Wide:  All  except 
Earth/Sun 

Any 

Low 

Medium/ 

High 

Star  trackers  vary  by  weight,  accuracy,  and  cost  and  there  are  many  developments 
in  modem  days  to  develop  a  star  tracker  that  can  meet  all  the  requirements  of  accurate 
attitude  determination  along  with  low  cost  and  weight.  AeroAstro,  Inc.  and  the 
Massachusetts  Institute  of  Technology  Space  Systems  Laboratory  did  develop  the 
Lightweight  Inexpensive  Star  Tracker  (LIST)  and  the  Fast  Angular  Rate  Miniature  Star 
Tracker  (FAR-MST)  with  the  specifications  shown  in  Table  2.3.  [9] 

Nowadays,  star  trackers  are  been  more  developed  with  much  better  accuracy  and 
lightweight.  The  accuracy  varies  from  0.1  arcsecond  to  less  than  100  arcsecond  for 
attitude  determination  [17].  One  of  the  good  star  trackers  is  called  SUNSAT,  and  its 
performance  parameters  are  shown  in  Table  2.4.  This  star  tracker  specifications  are  used 
in  the  simulation  results  in  Chapter  IV. 


13 


Table  2.3:  LIST  and  FAR-MST  specifications  [9] 


Parameter  (Units) 

LIST 

FAR-MST 

Dimensions  {cm?) 

5.1  X  7.6  X  7.6 

15  X  8  X  8 

Mass  {kg) 

0.3 

0.9 

Power  consumption  {Watt) 

<1 

3 

Number  of  stars  in  FOV 

<4 

>2 

Pitch/Yaw  accuracy  {arcsecond) 

70 

100 

Roll  accuracy  {arcsecond) 

1080 

=  1080 

Field  of  view  {deg) 

30 

25  to  45 

Table  2.4:  Performance  parameters  of  the  SUNSAT  star  tracker  [13] 


Parameter 

Units 

Size 

425  cm? 

Mass 

0.5  kg 

Power  consumption 

Ml  Watt 

Number  of  stars  in  FOV 

>3 

Accuracy 

12  arcsecond 

Update  rate  for  tracking  stars 

every  1  second 

Field  of  view 

8.33  xW.ll  deg 

2,6  Kalman  Filter 

Kalman  filter  is  a  recursive,  optimal  data  processing  algorithm  that  is  used  to 
predict  the  mean  and  covariance  of  specified  states  [11].  There  are  different  types  of 
Kalman  filters  which  can  be  used,  depending  on  the  system  dynamics  and  behavior. 
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including  linear  and  nonlinear  Kalman  filters.  For  the  nonlinear  Kalman  filter,  there  are 
two  famous  systems  used  for  nonlinear  systems,  the  Unscented  Kalman  Filter  (UKF)  and 
the  Extended  Kalman  Filter  (EKF).  This  researeh  will  focus  on  the  linear  Kalman  filter 
and  eould  use  aspects  of  the  unseented  Kalman  filter. 

2. 6. 1  Linear  Kalman  Filter 

The  linear  Kalman  filter  is  used  when  the  dynamic  and  measurement  models  are 
linear.  The  dynamic  model  of  the  continuous  linear  Kalman  filter  is 

x(t)  =  F  x(t)  +  B  u(t)  +  G  w(t)  (2.2) 

z(tfe)  =  H  x(tfe)  +  v(tfe)  (2.3) 

where  x(t)  is  the  state  veetor,  F  is  the  dynamics  matrix,  B  is  the  control  input  matrix,  u  is 
the  eontrol  input  vector,  z(tfc)  is  the  measurement  veetor,  H  is  the  measurement  matrix, 
and  where  the  dynamic  noise  w(t)  and  the  measurement  noise  v(tfc)  are  uncorrelated 
white  Gaussian  noises  with  zero  mean  and  covarianees  defined  as  [11] 


E[w(t)w^(t  +  t)]  =  Q  6(t) 

(2.4) 

E[v(tfe)v^(ty)]  =  R5(/c  -;) 

(2.5) 

where  6(t)  is  the  Dirac  delta  function,  and  6(/c  —  j)  is  the  Kronecker  delta  function. 

Since  this  model  will  be  implemented  in  a  discrete  system,  we  are  interested  in 
transforming  the  above  continuous  model  into  a  diserete  model.  The  discrete  model  of  a 
linear  Kalman  filter  is  defined  by 

x(tfe)  =  tfe_i)  x(tfc_i)  +  Ba  u(tfe_i)  +  GaWa  (2.6) 

where  the  above  matrices  are  calculated  as 

(2.7) 
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Bd  =  F  -  I)B 


(2.8) 


Gd  =  I  (2.9) 

And  Wjj  is  a  zero  mean  white  Gaussian  noise  with  eovarianee  defined  by 

Qd  =  E[WdWd^]  (2.10) 

where  ean  be  found  by  using  the  Van  Loan  Method  to  eonvert  from  eontinuous  to 
discrete  noise  [11]. 

Kalman  filtering  consists  of  two  steps,  time  propagation  and  measurement 
updates.  The  quantities  that  we  are  interested  in  are  the  mean  and  covariance  of  the  states, 
which  will  be  given  the  symbols  and  P^,  respectively. 

2. 6. 1.1  Propagation  Propagation  consists  of  estimating  the  current  mean 

and  covariance  using  the  previous  mean  and  covariance  [1 1],  we  define  propagation  as 

tfe_i)  x+_^  +  (2.11) 

Pr^  =  tfe-i)  tfe-i)  +  Qd  (2-12) 

where  denotes  the  previous  value  before  the  measurement  update  and  "+"  denotes  the 
value  after  the  measurement  update. 

2. 6. 1.2  Measurement  Update  When  a  measurement  is  available  at  time 
k,  the  states  are  updated  in  the  following  manner 

x+  =  x[-^  +  -  Ht,x[-J  (2.13) 

where  is  the  kalman  filter  gain,  and  it  is  given  by  the  following  equation 

Kt,  =  (2.14) 
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And  Hfe  is  the  measurement  matrix.  Using  the  gain  and  measurement  matrix,  the 


eovarianee  after  an  update  ean  be  ealeulated  by 

P<t  =  (' -  K  (2.15) 


2.6.2  Unscented  Kalman  Filter 

The  Unseented  Kalman  Filter  (UKF)  is  used  for  nonlinear  systems  and  it  is  based 
on  the  prineiple  of  using  a  set  of  appropriately  ehosen  weighted  points  to  parameterize 
the  means  and  eovarianees  of  probability  distributions  [6].  The  UKF  is  based  on  the 
unseented  transformation,  whieh  is  the  transformation  of  a  set  of  so-ealled  sigma  points, 
using  a  nonlinear  funetion  [6].  The  sigma  points  along  with  their  weighting  are  ehosen  in 
a  well-known  algorithm,  whieh  is  given  by  the  following  equations: 


Jo  =  ^ 

w,  =  — 

^  n+k 

(2.16) 

Xi  =  ^  +  U  (n  +  k)P^^) . 

Wi=  /  ^ 

^  2(n-\-k) 

(2.17) 

Xi+n  =  2c  + 

~  2(n+fe) 

(2.18) 

where  x  denotes  the  sigma  points,  and  W  is  the  assoeiated  weight  of  the  sigma  points. 
These  sigma  points  are  passed  through  a  nonlinear  mapping  funetion  to  result  in 
transformed  sigma  points  [6].  The  transformed  sigma  points  with  their  mean  and 
eovarianee  are  shown  by  the  following  equations: 

The  transformed  sigma  points  are 

Vi=f\Xi\  (2.19) 

The  weighted  mean  of  the  transformed  sigma  points  is 
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(2.20) 


The  weighted  covarianee  of  the  transformed  sigma  points  is 

Pyy  =  I.l"oW,{yt-y)iy,-yr  (2.21) 

The  UKF  performs  exaetly  like  the  Seeond  Order  Gauss  Filter  but  without  the 
need  to  ealeulate  Jaeobeans  of  the  nonlinear  functions  in  the  system  [6].  The  ease  of 
implementation  and  the  high  estimation  accuracy  of  the  unscented  transformation  (UKF), 
sometimes  make  it  better  filtering/estimation  algorithm  than  the  Extended  Kalman  Filter 
(EKF)  for  nonlinear  systems  [6]. 


2.7  Previous  Work 

In  this  section,  previous  work  related  to  my  thesis  will  be  presented  and  discussed. 

It  will  include  researches  in  the  celestial  navigation  field. 

2. 7. 1  Correction  Technique  for  Velocity  and  Position  Errors  of  Inertial  Navigation 
System  by  Celestial  Observations  [3] 

Gul  and  Jiancheng  [3]  presented  a  technique  to  correct  some  of  the  accumulated 
errors  in  the  inertial  navigation  system  (INS)  of  a  space  vehicle  using  stars  observations. 
The  accumulated  errors  that  were  considered  in  their  research  are: 

•  Accelerometer  bias. 

•  Gyro  drift  (s). 

•  Initial  misalignment  error  (^o)- 

In  their  research,  a  ballistic  missile  is  simulated  to  demonstrate  the  validity  of  the 
method.  The  flight  path  of  the  missile  is  divided  into  three  phases.  The  first  phase  is  from 
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the  launch  point  until  the  missile  crosses  the  atmosphere,  the  second  phase  is  from  the 
point  where  the  missile  crosses  the  atmosphere  to  the  point  of  burnout  (the  point  where 
the  engine  of  the  missile  is  disconnected),  and  the  third  phase  is  after  the  burnout  point  to 
the  point  of  impact  of  the  missile  with  the  ground  target. 

The  misalignment  error  (cptm)  is  calculated  by  observing  a  star  at  time  tm  after 
the  missile  crosses  the  atmosphere,  using  a  star  tracker  mounted  on  the  missile,  then  a 
few  seconds  later  another  star  observation  is  made  which  results  in  a  second 
misalignment  error  (cptm+T)  Using  the  two  calculated  observations,  the 

gyro  drift  (s)  can  be  calculated  as  follows: 

(Ptm+r  -  (Ptm  =  Ci  dt  S  =  P  S  (2.22) 

£  =  P~^i(ptm+T  -  (Ptm)  (2.23) 

where  is  the  DCM  to  transform  from  the  body  frame  to  the  inertial  frame. 

Using  the  gyro  drift  in  (2.23),  the  initial  misalignment  error  (cpo)  is  calculated  by 

(po  =  (ptm  -tme  (2.24) 

By  using  the  gyro  drift  and  the  initial  misalignment  error,  the  position  and 
velocity  of  the  missile  is  corrected  at  this  time.  After  the  burnout  point,  the  missile  takes 
in  a  free  flight  motion  until  it  hits  the  ground  target,  so  the  output  of  the  accelerometer  of 
the  missile’s  INS  after  the  burnout  point  is  used  as  the  accelerometer  bias.  Then,  the 
position  and  velocity  errors  due  to  the  accelerometer  bias  can  be  calculated  to  correct  the 
position  and  velocity  of  the  missile. 

The  celestial  navigation  method  used  in  the  research  [3]  is  simulated  for  200 
seconds  flight  time  for  a  ballistic  missile,  providing  a  tremendous  enhancement  for  the 
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INS  of  the  missile.  The  teehnique  presented  in  the  researeh  is  valid  for  small 
misalignment  angles  and  gyro  drift.  The  teehnique  could  be  enhanced  to  result  in  more 
accurate  results  by  using  Kalman  filters  to  reduce  the  propagated  errors  in  the  INS. 
However,  their  technique  does  not  apply  for  aircraft  trajectories,  because  there  is  not  a 
free-fall  portion  of  the  trajectory. 

2.7.2  A  Iternate  of  GPS  for  Ballistic  Vehicle  Navigation  [4] 

This  research  [4]  is  a  continuation  of  the  previous  discussed  approach  of  Gul  and 
Jiancheng  [3].  In  this  research,  they  enhanced  the  accuracy  of  the  technique  by 
implementing  an  Unscented  Kalman  Filter  (UKF)  to  reduce  the  accumulated  errors  in  the 
INS.  In  this  research,  the  sigma  points  (UKF  technique)  were  propagated  through  the 
inertial  navigation  equations,  mechanized  in  launch  inertial  frame.  A  simulation  of  158 
seconds  of  data  for  the  powered  phase  of  a  ballistic  missile  is  simulated.  The  error  mean 
and  covariance  at  time  instant  160  seconds  from  the  beginning  of  navigation  were 
computed  from  the  transformed  sigma  points.  The  previous  process  was  repeated  with 
velocity  and  position  error  correction  by  incorporating  the  detected  initial  misalignment, 
gyro  drift  and  accelerometer  bias.  The  mean  and  standard  deviation  of  the  errors  in 
velocity  and  position  obtained  from  INS,  with  and  without  incorporation  of  the  correction 
technique,  are  listed  in  Table  2.5. 
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Table  2.5: 


Error  statistics  at  time  instant  160  seconds  from  launch  time  [4] 


Parameter 

(Units) 

Without  correction 

With  correction 

Mean 

1 -sigma 

Mean 

1 -sigma 

Vx  {m/s) 

-0.019 

8.494 

0.004 

0.013 

Vy  {m/s) 

-0.009 

6.932 

0 

0.014 

Vz  {m/s) 

0 

10.910 

0.006 

0.012 

U  {m) 

-1.51 

739.60 

0.01 

1.23 

Vy  {m) 

-0.91 

476.70 

0.62 

1.98 

U  {m) 

0 

878.15 

0.17 

0.79 

In  Table  2.5,  V^,  Vy,  V^,  r^^.,  and  are  the  missile  velocity  and  position  in  three 
axes,  respectively.  From  table  1,  the  results  show  that  the  velocity  errors  (1 -sigma)  are 
reduced  from  (7  to  11)  m/s  to  less  than  0.015  m/s  along  each  axis.  Also,  position  errors 
(1 -sigma)  are  reduced  from  (470  to  870)  meters  to  less  than  2  meters  along  each  axis. 

The  results  found  by  using  the  UKF  gives  a  motivation  for  further  analysis  by 
implementing  different  types  of  Kalman  filters. 


2. 7. 2  Compass  Star  Tracker  for  GPS-like  Applications  [7] 

Samaan,  Mortar!  and  Juan  in  their  article  [7]  have  made  an  in  depth  description 
and  analysis  of  the  Compass  Star  Tracker,  which  is  believed  to  be  a  new  technological 
innovation  with  regards  to  estimating  of  attitude  and  location  of  spacecrafts.  The  article 
outlines  the  alignment  of  camera  optical  axis  in  relation  to  the  gravitational  direction  and 
time  as  the  basic  concept  behind  this  system.  Although  the  system  employees  the  use  of  a 
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number  of  significant  concepts  of  Global  Positioning  System  (GPS),  it  cannot  be  used  as 
its  substitute  due  to  the  fact  that  it  suffers  from  the  night-only  limitation  in  addition  to  the 
need  for  calm  and  clear  weather  conditions  [7]. 

The  Compass  Star  Tracker  (CST)  application  can  be  applied  when  navigating  in 
non-GPS  environments  such  as  the  Moon  and  planets  or  as  backup  system  when  GPS 
fails,  with  its  accuracy  depending  on  aspects  such  as  CCD  resolution,  time  precision  and 
centroiding  accuracy  [7].  In  this  article,  they  described  the  estimation  of  latitude  and 
longitude  positions  in  space  using  the  Monte-Carlo  stimulated  image  and  the  night  sky 
test  through  a  gravity  pendulum  [7].  Their  description  embraces  the  use  of  the  earth 
centered  inertial  frame  and  camera  body  frame  (axes  x,  y,  z)  as  shown  in  Fig.  2.5. 


Figure  2.5:  Reference  frame  for  Earth  and  optical  axis  [7] 
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In  Fig.  2.5,  the  x-axis  is  the  camera  optical  axis,  aligned  to  the  local  vertical. 
There  are  number  of  parameters  in  the  figure,  defined  as,  X  being  the  longitude,  (p  the 
latitude,  \|;  the  angle  between  the  vernal  equinox  (7)  and  the  Greenwich  Meridian  (G), 
and  8  is  the  angle  between  the  camera’s  y-axis  and  the  local  East  (E).  Samaan,  Mortari 
and  Juan  identified  these  as  the  unknown  parameters  that  to  be  calculated. 

In  the  following  equations,  there  are  reference  frames  that  to  be  explained.  The 
subscript  B  is  used  for  the  body  frame  of  the  camera,  G  as  the  Greenwich  frame,  I  as  the 
inertial  frame  and  E  as  the  local  frame  [7]. 

Assume  is  the  attitude  matrix  for  the  camera  body  frame  with  respect  to  the 
inertial  frame  and  assume  that  A®'^  is  the  attitude  matrix  for  the  camera  body  frame  with 
respect  to  the  local  frame  [7],  then 

cos  8  sin  8  0 

=  R3  (e)  =  —  sin  8  cos  e  0  (2.25) 

.0  0  1. 

Also,  assume  that  A^^^is  the  attitude  matrix  for  the  local  reference  frame 
with  respect  to  the  Greenwich  frame  [7],  then 


A^/g^ 

R2(- 

^)R3(2) 

(2.26) 

coscp 

0 

sin^' 

'  cosl 

sinl 

0 

0 

1 

0 

—  sinl 

cosl 

0 

(2.27) 

—  sinq) 

0 

cos  q). 

.  0 

0 

1. 

These  equations  relate  through  the  equation  A^^^  =  A^'^  A^^^  =  A^''^  , 

that  can  be  used  to  solve  the  unknown  parameters  using  the  following  equations 


The  latitude  (p  is  computed  by 

=  A^/g  (3,3)  (2.28) 
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The  longitude  A  is  eomputed  by 


tanl  = 


_AB/G  ^3  2) 
_AB/G  (-31) 


(2.29) 


The  East  direction  e  is  computed  by 


tan£  = 


_AB/G  ^2,3) 

(1,3) 


(2.30) 


Using  the  night  sky  test  that  employed  the  use  of  a  star  image  eaptured  by  a 
Star 1000  eamera,  Samaan,  Mortari  and  Juan  earried  out  a  eentroiding  algorithm  to  find 
the  star  eenters,  while  star  identilieation  was  done  using  the  Pyramid  Star-ID  teehnique. 
This  led  to  estimating  the  attitude  matrix  using  the  ESOQ-2  algorithm.  Having  been 
able  to  find  the  time  of  the  measured  image,  the  A  matrix  was  evaluated  [7]. 

Consequently,  the  equation  matrixes,  led  to  identifying  the  longitude  and  latitude, 
with  0.008*’  and  0.02*^  errors,  respeetively,  as  eompared  to  the  aetual  longitude  and 
latitude  values  of  a  GPS  receiver  [7].  The  Monte-Carlo  simulation  was  also  applied 
through  the  use  of  a  camera  with  its  optical  axis  pointing  at  the  zenith.  They  selected  the 
longitude  to  be  at  -  104.9658°  and  the  latitude  at  39.7546°  with  a  compass  angle  e  of  10°. 
After  obtaining  the  initial  and  observed  directions  of  the  star,  an  optimal  estimate  of 
attitude  matrix  is  done  using  the  ESOQ-2  estimator,  and  the  estimated  values  of  the 
longitude  was  found  to  be  -104.9704°,  latitude  of  39.7528°  and  local  east  angle  of 
10.0393°  [7]. 

Eor  Samaan,  Mortari  and  Juan,  these  results  provided  optimism  in  the  CST 
approach  through  which  standard  algorithm  can  be  used  in  processing  the  images  of  stars 
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and  location  of  the  stars  using  a  camera  [7].  Although  this  method  seems  applicable,  it 
has  limitations  of  accuracy  in  the  system,  which  necessitates  more  research  and  studies 
through  which  WGS-84  model  would  be  quantified.  Samaan,  Mortar!  and  Juan  have 
evidently  brought  into  light  the  possibility  of  using  star  trackers  in  estimating  position 
together  with  attitude  [7]. 


2,8  Chapter  Summary 

In  this  chapter,  mathematical  background  related  to  the  research  was  discussed 
and  explained.  In  the  next  chapter,  the  methodology  that  will  be  used  in  the  research  will 
be  explained  in  details. 
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III.  Methodology 


This  chapter  will  explain  the  mathematical  approach  for  simulating  the  inertial 
navigation  system  aided  by  a  star  tracker,  global  positioning  system,  and 
barometer.  The  ehapter  is  organized  as  follows.  First,  a  bloek  diagram  that  describes  the 
system  structure  is  shown.  Second,  a  truth  model  that  represents  the  true  trajectory  of  the 
aircraft  will  be  presented.  Next,  a  dynamie  model  for  the  inertial  navigation  system  error 
model  is  explained  in  detail.  Finally,  measurements  models  for  different  measurements 
sources  are  discussed  and  explained. 


3,1  System  Block  Diagram 

The  system  bloek  diagram  is  important  to  understand  the  functions  and  rule  of  the 
different  eomponents  in  the  system.  Fig.  3.1  shows  the  interrelationships  between  the 
system’s  components  in  a  funetional  bloek  diagram. 

In  the  system  block  diagram,  we  first  start  to  generate  the  system  parameters  that 
will  have  all  the  parameters  of  the  navigating  vehiele.  Then,  we  generate  a  truth  trajeetory 
using  Trajeetory  Generator  bloek,  which  will  be  explained  in  the  next  Section.  Next,  we 
use  the  INS  simulator  to  generate  the  system  dynamies,  and  it  will  be  explained  in 
Section  3.3.  The  GPS,  barometer,  and  star  tracker  measurements  are  generated  by  using 
the  truth  trajeetory  plus  additional  sensors  biases,  the  measurement  models  will  be  shown 
and  explained  in  Section  3.4.  Then,  a  Kalman  filter  is  used  to  estimate  the  navigation 
errors.  Finally,  we  use  the  estimated  errors  to  correct  the  INS  navigation  parameters. 
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Figure  3.1:  The  system  bloek  diagram 


3.2  Truth  Model 

There  are  different  truth  models  that  ean  be  used  to  represent  the  aircraft  trajectory. 
For  this  research  the  First  Order  Gauss  Markov  Acceleration  (FOGMA)  model  was 
selected  for  its  wide  range  of  use  in  aircraft  simulation  applications.  The  general  form  of 
a  dynamic  model  is  given  by 

x(t)  =  Fx(t)+  GW;,(t)  (3.1) 


The  dynamics  of  a  FOGMA  model  are  described  in  terms  of  velocity  v,  position  p 
and  acceleration  a,  by 


p  =  V 

(3.2) 

V  =  a 

(3.3) 

1 

a  =  —  -  a  + 

(3.4) 

27 


where  x  is  the  time  eonstant.  The  matriees  and  veetors  in  Equation  (3.1)  are  defined  as 
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(3.5) 


(3.6) 
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(3.7) 


And  w^(t)  is  an  additive  white  Gaussian  noise  proeess  sampled  at  time  t,  with 


eovariance  defined  as 


E  [w^(t)wj(t  +  t)]  =  Q  6(t) 


(3.8) 


Y2g'^ 
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0 


0 
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0 

0 


(3.9) 
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where  is  the  desired  varianee  of  the  eomponents  of  aoeeleration  veetor  a^,  and  a^, 
and  6(t)  is  the  Dirae  delta  funetion. 


3,3  Dynamic  Model 

3.3.  J  Inertial  Navigation  System  Error  Model 

There  are  several  models  that  ean  be  used  to  represent  the  INS  errors.  For  this 
researeh  the  16  states  error  model  expressed  in  the  navigation  frame  (NED)  will  be  used, 
based  on  the  model  given  in  [12],  As  before,  the  system  dynamies  are  given  by 

x(t)  =  Fx(t)+  Gw(t)  (3.10) 

where  F  is  the  system  eontinuous-time  dynamies  matrix  and  w(t)  is  the  system  noise 
veetor  [14]. 

The  system  states  are  represented  by  the  system  state  veetor  x(t),  whieh  eontains 
the  INS  position  error  6P,  veloeity  error  5v,  tilt  error  6e,  aeeelerometer  bias  and 
gyroseope  bias  6b^.  Eaeh  of  the  previous  states  are  in  three  axis  dimensions  (i.e.,  x,  y  and 
z),  and  the  last  state  is  the  sealar  barometer  bias,  Sbaro  (t).  The  system  state  veetor  is 
deseribed  as 


x(t)  = 


r  5P(t)  1 
6v(t) 
6e(t) 
6b„(t) 
6b^(t) 


LSbaro  (t)J 


16X1 


(3.11) 
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The  system  continues-time  dynamics  matrix  F  is  a  16x16  matrix  that  represents 
the  INS  navigation  equations  mechanized  in  the  local  geographic  frame  (navigation- 
frame,  NED)  [12],  expressed  as 


^3x3 

^3X3 

^3x3 

^3x3 

^3x3 

^3X1 

nnnne 

-2QSlfe 

Q  (Px) 

^3x3 

^3X1 

^3x3 

^3x3 

^3x3 

— r” 

^3X1 

^3x3 

^3x3 

^3x3  ~ 

Vxfl  ^3X3 

^3x3 

^3X1 

(3.12) 
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Vx^  ^3X3 

^3X1 

.  0lx3 

0lx3 

0lx3 

0lx3 

0lx3 

-  Vxfc. 

The  components  in  the  F  matrix  are  described  as  follows 


•  Cg  Is  the  DCM  from  ECEF-frame  to  navigation- frame,  and  it  is  computed  as 


C 


n 

e 


sinL  cosl 
—  sinl 
cosL  cosl 


—  sin  L  sin  1 

cosl 

—  cos  L  sin  1 


cosL 

0 

—  sinL. 


X  is  Longitude 
L  is  the  Latitude 


(3.13) 


•  Is  the  DCM  from  navigation-frame  to  ECEE-frame,  and  it  is  the  transpose 
ofC^(i.e.,C«  =  Cf) 

•  Is  the  DCM  from  the  body-frame  to  the  navigation-frame,  and  it  is 
computed  as 


fn  _ 


COS  9  COSlp 
cos6  sim/; 
— sin0 


-COS0  sin0 


sin0  sin0 


-l-sin0  sin0  cosxp  +cos(p  sin0  cosxp 

COS0  COS0  — sin0  cos0 

-l-sin0  sin0  sin0  -l-cos0  sin0  sin0 

sin0  COS0  COS0  cos0 


(3.14) 


where  0  is  the  rotation  angle  around  the  z-axis  (yaw),  9  is  the  rotation  angle  around  the 
y-axis  (pitch),  and  0  is  the  rotation  angle  around  the  x-axis  (roll)  [12]. 
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•  G  is  the  gradient  of  the  gravity  veetor  [1],  and  it  is  computed  as 

G=jj^[3F(pT-l]-W.)^  (3.15) 

where  p®  is  the  ECEF  position  vector,  p®  is  the  ECEE  position  unit  vector,  and  ftfg  is  the 
skew  symmetric  form  of  the  Earth’s  angular  rate  (ufg  (7.2921 15  xlO“^  rad/s)  [1]. 

•  f ”  is  the  specific  force  expressed  in  the  navigation-frame,  and  it  is  computed 
by 

(3.16) 

where  f  ^  is  the  specific  force  in  the  body-frame. 

•  (f”x)  Is  the  skew  symmetric  form  of  the  specific  force  expressed  in  the 
navigation  frame. 

•  Ta  Is  the  accelerometer  time  constant 

•  Is  the  gyroscope  time  constant 

•  Tj,  Is  the  barometer  time  constant 

•  O3X3  Is  3x3  Zero  matrix 

•  I3x3ls3x3  Identity  matrix 


w 


Wa 

^  a, bias 
^g,bias 
^^b,bias 


(3.17) 
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where  w^,  Wg,  Wa,bias,  ^g.bias  ,  and  MST^Mas  are  the  aeeelerometer  random  walk,  gyro 
random  walk,  aeeelerometer  bias,  gyro  bias,  and  barometer  bias  random  proeess, 
respeetively  [12],  The  noise  matrix  G  is  given  by 
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(3.18) 


3,4  Measurement  Model 

Three  different  sourees  of  measurements  will  be  used  to  update  the  Kalman  filter 
to  eorreet  the  INS  states.  The  measurement  sourees  that  will  be  used  are 

•  Global  positioning  system  (GPS) 

•  Star  traeker 

•  Barometer 

The  Global  positioning  system  (GPS)  is  a  spaee-based  navigation  system  that 
provides  time  information  and  loeation  of  a  vehiele  (e.g.,  oar,  ship,  airoraft)  in  all  weather 
oonditions.  It  is  a  well  used  navigation  system  in  most  of  military  and  oivilian  systems 
beoause  of  its  high  aoouraoy  of  positioning  and  global  ooverage.  However,  GPS  oan  be 
inadequate  to  use  in  some  oases  when  its  signals  are  not  available  due  to  obstaoles  or 
jamming  teohniques. 

In  the  other  hand,  star  traokers  or  what  is  oalled  oelestial  navigation,  is  a  robust 
system  that  is  not  susoeptible  to  GPS  interferenoe  and  oan  be  used  for  high  aoouraoy 


32 


positioning  and  navigation.  The  last  measurement  source  is  the  barometer,  which  is  a 
device  used  to  calculate  the  altitude  of  an  aircraft  using  the  atmosphere  pressure. 

In  general  the  measurement  models  will  be  expressed  in  the  following  linear  form 

z(tfe)  =  Hx(tfe)  +  v(tfe)  (3.19) 

where  z(tfc)  is  the  measurement  vector,  H  is  the  measurement  matrix  and  v(tfe)  is  a  white 
Gaussian  noise  with  zero  mean  and  covariance  defined  as  [11] 

E[v(tfc)v^(t;)]  =  R6(/c-;)  (3.20) 

where  6(/c  —  j)  is  the  Kronecker  delta  function. 


3.4.1  Global  Positioning  System  Model 

For  the  GPS  measurement  model,  the  measurement  vector  "Lgpsi^k)  is  the 


difference  between  the  GPS  position  and  velocity  in  3-axis  and  the  INS  position  and 
velocity  in  3-axis.  The  GPS  position  and  velocity  are  assumed  to  be  calculated  from  a 
GPS  receiver  on  the  aircraft,  and  it  is  equal  to  the  true  position  and  velocity  plus  an 
additional  noises.  The  INS  position  and  velocity  are  equal  to  the  true  position  and 
velocity  minus  the  INS  position  and  velocity  errors  that  are  calculated  from  the  dynamic 


model  in  Section  3.3.  The  measurement  vector  "Lapsi^k)  is  given  by 


^gps 


(tfe)  = 


Vx,gps  -  Px,ins 
Py,gps  -  Vy,ins 
Pz,gps  —  Pz,ins 
^x,gps  -  ^x,ins 
^y,gps  -^y,ins 
^z,gps  -^z,ins 


(3.21) 


The  measurement  matrix  H^ps  is  6x  16  matrix  and  given  by 
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(3.22) 
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The  measurement  noise  eovariance  Rnps  is  6x6  matrix  and  given  by 
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(3.23) 


where  Op  x.gps-^  ’^p.y.gps^  are  the  variances  of  the  GPS  position  measurement 

noise  in  x,  y,  and  z  axis,  respectively.  Also,  <3y_x,gps^  ^v.y.gps’  ^v,z,gps  the 

variances  of  the  GPS  velocity  measurement  noise  in  x,  y,  and  z  axis,  respectively. 


3.4.2  Barometer  Model 

The  barometer  measurement  vector  is  expressed  by  the  following  equation 

"^baroQ-k)  ^baro  Pz  (3-24) 

where  p^  is  the  true  altitude,  and  h^jaro  is  the  barometer  altitude  which  is  given  by 

^baro  ^b 

where  b^  is  the  barometer  bias,  and  Wj,  is  an  additive  white  Gaussian  noise  process. 

The  barometer  bias  is  modeled  as  first  order  Gauss-Markov  process,  which  is 
expressed  by  the  following  differential  equation 

(,'>=  -fb'>+  (3.25) 
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where  is  the  barometer  time  constant  and  is  a  zero  mean  white  Gaussian  noise 


with  a  covariance  R^.^ias 
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b,bias 


2a 
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b,bias 


(3.26) 


The  measurement  noise  covariance  Rbaro  is  given  by 

^baro  =  (^b  (3-27) 

where  is  the  standard  deviation  of  the  barometer  altitude.  The  measurement  matrix 
iibaro  is  given  by 

Hbaro  =  [0  0  -1  000000000000  l]ixi6  (3.28) 


3.4.2  Star  Tracker  Model 

The  star  tracker  calculates  the  attitude  of  the  aircraft  and  the  accuracy  of  attitude 
calculation  depends  on  the  specifications  of  the  star  tracker  used  and  the  surrounding 
environment. 

In  this  research,  an  unscented  transformation  is  used  to  transform  the  star  tracker 
output  (Euler  angles)  along  with  their  uncertainties  to  get  the  tilts  and  their  uncertainties. 
The  star  tracker  output  is  given  by 


OWtzstar(tfe) 


^star 

4^star 

-^star- 


(3.29) 


where  9  star  ^  (pstar^  aiid  Ip  star  ^rc  the  roll,  pitch,  and  heading  angles  respectively,  that  are 
obtained  from  the  star  tracker.  In  this  research,  these  angles  are  simulated  by  adding  a 
white  Gaussian  noise  to  the  true  angles  that  are  obtained  from  the  truth  model. 
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The  star  tracker  output  variances  are  given  by 


out 


^star 


0  0 
0  ol  0 

0  0  ctJ, 


(3.30) 


where  Og,  and  are  the  variances  in  the  roll,  pitch,  and  heading  respectively.  These 
variances  are  the  accuracy  of  the  star  tracker  used,  and  they  are  given  by  Table  2.4. 

The  star  tracker  and  INS  Euler  angles  are  used  to  form  a  new  DCM,  which  is 
given  by 

=  (3.31) 


where  and  are  given  by  Equation  (2.1). 

Using  the  new  DCM,  a  skew  symmetric  matrix  of  the  tilts  is  obtained  by  taking 
the  matrix  natural  logarithm 


A  =  In(C-) 

Where  the  tilts  in  each  axis  are  obtained  as  follows 


■  A(3,2)  ■ 

e  = 

= 

-A(3,l) 

A(2,l) 

(3.32) 


(3.33) 


Equations  (3.31)  through  (3.33)  describe  a  nonlinear  function  that  maps  measured 
and  INS  Euler  angles  to  tilt  vectors  e 


^  f  star ’  ^star’  ^stav  ^INS’  4>  I  NS  1 4’ ins)  (3.34) 

The  variables  and  0/^5  are  considered  to  be  known  values  in  this 

equation. 

We  then  use  an  unscented  transformation  [6]  to  calculate  the  expected  values  for 
€  (E[e])  and  the  covariance  matrix  of  e  (Cov(e)),  these  are  then  used  directly  as 
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measurements  in  the  Kalman  filter.  Therefore,  the  star  tracker  measurement  vector  and 


covariance  matrix  are  given  by 


^star(tfe)  £[6] 

^star  ~  Cov(6') 

The  measurement  matrix  of  the  star  tracker  model  is  given  by 


(3.35) 

(3.36) 
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3,5  Kalman  Filter  Implementation 

Based  on  the  linear  dynamic  and  measurement  models  of  this  system,  a  linear 
Kalman  filter  is  a  good  choice  for  this  system.  The  Kalman  filter  equations  described  in 
Section  2.6  are  used  in  the  simulation  with  the  measurement  models  described  in  Section 
3.4  to  update  the  INS  parameters. 


3,6  Chapter  Summary 

This  chapter  explained  and  discussed  the  truth,  dynamic,  and  measurement 
models  that  will  be  implemented  in  MATLAB  to  get  simulation  results  for  the  system. 
Next  chapter  will  show  the  simulation  parameters  used  and  the  simulation  results 
developed. 
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IV.  Simulation  Results 


In  this  chapter,  simulated  performanee  results  for  the  methodology  diseussed  in  the 
previous  chapter  will  be  shown  and  analyzed.  We  will  start  with  explaining  the 
different  INS  grades  that  will  be  used  in  the  simulation  along  with  their  parameters.  Next, 
simulation  scenarios  will  be  explained.  Then,  a  Kalman  filter  validation  step  will  be 
shown.  Then  in  the  following  sections,  results  of  different  scenarios  including  GPS,  star 
tracker  and  barometer  aiding  is  presented  and  analyzed. 

There  are  three  different  grades  of  INS;  eommereial,  tactieal  and  navigation.  The 
commercial  grade  INS  has  low  quality  sensors  (i.e.  Accelerometers  and  Gyroscopes)  and 
these  sensors  should  be  calibrated  after  installation  in  the  Inertial  Measurement  Unit 
(IMU)  to  be  used  for  short  duration  flights.  In  eontrast,  taetical  grade  INS  is  a  medium 
quality  grade  that  is  used  for  medium  flight  durations  of  several  minutes.  Finally,  the 
navigation  grade  INS  is  used  for  long  flight  durations  and  has  good  quality  sensors.  Key 
error  parameters  for  the  three  INS  grades  are  shown  in  Table  4.1. 

Table  4.1;  Parameters  used  in  simulation  for  different  INS  grades.  All  INS  grades 
have  a  time  eonstant  of  1^=  Tg=  3600  seeonds  [14]. 


INS  Grade 

(rad/s) 

(m/s^) 

^9rw 

(rad/s  ^/2) 

u-rw 

(m/s^/2) 

Commercial  (Cloudcap  Crista) 

8.7e-3 

1.96e-l 

6.5e-4 

4.3e-3 

Tactical  (HG1700) 

4.8e-6 

9.8e-3 

8.7e-5 

9.5e-3 

Navigation  (HG9900  -  H764G) 

7.2e-9 

2.45e-4 

5.8e-7 

2.3e-4 
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In  Table  4.1,  the  gyroseope  time-correlated  bias  time  constant  is  denoted  by  Tg, 
the  accelerometer  time-correlated  bias  time  constant  is  denoted  by  the  gyroscope 
time-correlated  bias  standard  deviation  is  denoted  by  cr^,  and  the  accelerometer  time- 
correlated  bias  standard  deviation  is  denoted  by  a^.  Also,  the  accelerometer  and 
gyroscope  random  walk  noise  strength  is  denoted  by  and  respectively  [14], 

The  flight  dynamics  and  duration  limits  the  criteria  of  selecting  the  inertial  grade 
needed  for  the  application.  In  the  research,  the  previous  discussed  INS  grades  will  be 
simulated  for  different  flight  durations  depending  on  the  INS  grade  used  and  the  result 
analysis.  In  addition,  the  flight  dynamics  is  assumed  to  be  a  normally  straight  and  level 
flight  with  no  maneuvers  and  very  little  acceleration. 


4,1  Simulation  Scenarios 

In  the  following  sections  of  this  chapter,  there  are  two  scenarios  selected  to 
compare  between  the  different  measurements  models  described  in  chapter  III.  The  two 
scenarios  are  as  follows 

•  Scenario  one:  GPS  initialization,  Star  tracker  and  Barometer. 

•  Scenario  two:  GPS  initialization  and  Barometer. 

In  the  first  scenario,  GPS,  star  tracker,  and  barometer  measurements  will  be  used 
from  the  beginning  of  the  flight  but  the  GPS  will  be  only  for  the  first  200  seconds.  The 
second  scenario  will  be  like  the  first  scenario  but  without  the  star  tracker.  Table  4.2 
descries  the  star  tracker  parameters  used  in  the  research,  which  were  obtained  from  [13]. 
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Table  4.2:  Star  Tracker  Parameters 


Star  Tracker  Name 

SUNSAT  Star  Tracker 

Roll  Accuracy 

12  arcseconds 

Pitch  Accuracy 

12  arcseconds 

Yaw  Accuracy 

12  arcseconds 

4,2  Filter  Validation 

This  section  contains  simulated  navigation  results  using  the  INS  model  developed 
in  Section  3.3  and  the  measurement  models  developed  in  Section  3.4.  The  simulations  in 
this  section  use  the  INS  parameters  from  Table  4.1,  the  star  tracker  parameters  from 
Table  4.2,  and  the  navigation  parameters  from  Table  4.3. 

Before  developing  the  results,  Kalman  filter  validation  is  an  important  step  to 
verify  that  the  filter  is  well  designed  and  can  estimate  the  states  needed  for  this  research. 
The  filter  validation  is  carried  out  through  simulation  of  1000  Monte  Carlo  runs  for  the 
three  INS  grades. 

Figures  4.1,  4.2,  and  4.3  show  the  Monte  Carlo  runs  for  the  position  error  for  the 
commercial  grade  INS,  tactical  grade  INS,  and  navigation  grade  INS,  respectively. 


Table  4.3:  Simulation  Parameters  for  Navigation  Filter 


Kalman  Filter  Propagation  Time 

1  second 

Initial  Position 

(0,0,0)  m 

Initial  Velocity 

(200,0,0)  m/s 

Initial  Acceleration 

(0,0,0)  m/s^ 
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Figure  4.1;  Position  ensemble  standard  deviation  and  mean  versus  filter 
computed  standard  deviation  for  commercial  grade  INS. 
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Y  Error  (m)  X  Error  (m) 


Figure  4.2;  Position  ensemble  standard  deviation  and  mean  versus  filter 
computed  standard  deviation  for  tactical  grade  INS. 
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Figure  4.3;  Position  ensemble  standard  deviation  and  mean  versus  filter 
computed  standard  deviation  for  navigation  grade  INS. 


The  previous  figures  are  simulation  runs  when  INS  only  is  used  and  they  match 
the  results  developed  in  [14]  and  [12].  Also,  we  see  that  the  filter  computed  standard 
deviation  predicts  the  ensemble  standard  deviation,  which  would  be  expected  for  a 
properly  functioning  filter. 

For  further  filter  validation,  the  first  scenario  is  simulated  for  1000  Monte  Carlo 
runs  with  a  navigation  grade  INS,  and  the  position  error  is  shown  in  Fig.  4.4. 
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Figure  4.4:  Position  error  for  1000  Monte  Carlo  runs  of  the  first  scenario  for  a 

navigation  grade  INS. 


Fig.  4.4  proves  that  the  results  in  Fig.  4.3  are  not  outliers,  and  that  the  1000  Monte 
Carlo  runs  when  measurements  are  used  is  on  the  same  order  as  the  filter  computed 
standard  deviation  of  the  1000  Monte  Carlo  runs  in  Fig.  4.3.  In  Fig.  4.4,  we  see  that  there 
is  improvement  in  the  filter  computed  standard  deviation  when  using  the  star  tracker  and 
the  barometer  measurements.  In  addition,  the  errors  in  velocity,  tilt,  accelerometer, 
gyroscope,  and  barometer  are  shown  in  Fig.  4. 5-4. 9,  respectively. 
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Figure  4.5;  Velocity  error  for  1000  Monte  Carlo  runs  of  the  first  scenario 
(GPS  outage  at  200  sec.)  for  a  navigation  grade  fNS. 
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Figure  4.6:  Tilt  error  for  1000  Monte  Carlo  runs  of  the  first  seenario  for  a 

navigation  grade  INS. 
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Figure  4.7;  Accelerometer  error  for  1000  Monte  Carlo  runs  of  the  first 
scenario  for  a  navigation  grade  INS. 
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Figure  4.8;  Gyroscope  error  for  1000  Monte  Carlo  runs  of  the  first  scenario  for 
a  navigation  grade  INS. 
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Figure  4.9:  Barometer  error  for  1000  Monte  Carlo  runs  of  the  first  scenario  for 

a  navigation  grade  INS. 


In  order  to  measure  the  effects  of  INS  grade  on  the  results,  tactical  and 
commercial  grade  INS  were  simulated.  Fig.  4.10  shows  the  position  error  for  1000  Monte 
Carlo  runs  for  tactical  grade  INS  with  measurements  from  scenario  one.  We  see 
improvement  in  the  tactical  grade  when  star  tracker  and  barometer  are  used,  compared  to 
Fig.  4.2. 

Fig  4.1 1  shows  the  position  error  for  a  commercial  grade  INS  with  measurements 
from  scenario  one.  Also  in  the  commercial  grade,  we  see  a  good  improvement  when  star 
tracker  and  barometer  are  used,  compared  to  Fig.  4.1. 
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Figure  4.10;  Position  error  for  1000  Monte  Carlo  runs  of  the  first  scenario  (GPS 
outage  at  200  sec.)  for  a  tactical  grade  INS. 


50 


1 


X  10'* 


Figure  4.1 1;  Position  error  for  1000  Monte  Carlo  runs  of  the  first  scenario  for  a 
commercial  grade  INS. 


4,3  Star  Tracker  Performance  Improvement  on  INS  Grades 

This  section  is  to  discuss  the  impact  of  both  scenarios  discussed  in  Section  4.1  on 
the  different  INS  grades.  Since  the  filter  was  validated  in  the  previous  section, 
performance  analysis  will  be  conducted  based  on  a  pure  covariance  analysis.  The  results 
in  this  section  are  generated  in  accordance  with  Tables  4.1,  4.2,  and  4.3. 

In  this  research  we  are  primarily  interested  in  the  effect  of  using  star  tracker  on 
two  error  states,  position  and  tilt,  and  therefore  the  results  in  this  section  will  show  only 
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the  error  state  eovariance  of  the  position  and  tilt.  For  eonvenienee,  the  rest  of  the  error 
states  eovarienees  will  be  ineluded  in  Appendix  A. 

For  the  eommereial  grade  INS,  the  estimated  position  error  eovarianee  for  the  two 
seenarios  is  simulated  for  600  seeonds  and  shown  in  Fig  4.12.  We  see  from  the  figure 
how  the  star  traeker  (seenario  one)  has  a  signifieant  improvement  on  the  estimated 
position  error  eovariance  of  the  commercial  grade  INS,  it  decreased  from  IlxlO'^m  to 
3600m  in  the  x-axis  and  y-axis,  where  the  z-axis  remained  at  6m  for  both  scenarios 
because  of  the  barometer  aiding  used  in  the  two  scenarios.  Also,  the  estimated  tilt 
covariance  for  the  two  scenarios  is  shown  in  Fig.  4.13.  In  the  estimated  tilts  covariance 
we  see  a  tremendous  improvement  when  using  star  tracker  as  seen  in  scenario  one.  The 
commercial  grade  INS  decreased  to  5.8xl0“^rad  in  the  three  axes  when  using  the  star 
tracker,  and  it  increased  to  0.9rad  in  the  x-axis  and  y-axis  when  the  star  tracker  is  not 
used  as  seen  in  scenario  two,  and  the  z-axis  increased  to  1 .7rad. 

For  the  tactical  grade  INS,  the  estimated  position  error  covariance  for  the  two 
scenarios  is  simulated  for  600  seconds  and  shown  in  Fig  4.14.  We  see  from  the  figure 
how  the  star  tracker  (scenario  one)  has  improved  the  estimated  position  error  covariance 
of  the  tactical  grade  INS;  it  decreased  from  1 000m  to  300m  in  the  x-axis  and  y-axes. 
Also,  the  estimated  tilt  covariance  for  the  two  scenarios  is  shown  in  Fig.  4.15.  In  Fig  4.15 
we  see  an  improvement  when  using  star  tracker  as  seen  in  scenario  one.  The  tactical 
grade  INS  decreased  to  5.1xl0“^rad  in  the  three  axes  when  using  star  tracker,  while  the 
estimated  tilt  covariance  is  2xl0“^rad  in  the  three  axes  when  star  tracker  is  not  used. 
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(without  star  tracker) 


Figure  4.12:  Estimated  position  error  covariance  for  the  two  scenarios  for 

eommercial  grade  INS. 
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Figure  4.13;  Estimated  tilt  covariance  for  the  two  scenarios  for  commercial 
grade  INS. 
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Figure  4.14;  Estimated  position  error  covariance  for  the  two  scenarios  for 
tactical  grade  INS. 
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Figure  4.15:  Estimated  tilt  eovarianee  for  the  two  seenarios  for  taetieal  grade  INS. 


The  estimated  position  and  tilt  eovarianees  for  the  two  seenarios  for  the 
navigation  grade  INS  are  shown  in  Fig  4.16  and  Fig.  4.17  respeetively.  In  the  two  figures 
we  notiee  there  is  very  little  improvement  on  the  navigation  grade  INS  when  star  traeker 
is  used  or  not  used,  and  that  is  beeause  the  navigation  grade  INS  uses  good  quality  of 
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Y  Covarience  (m)  X  Covarience  (m) 


gyroscopes  and  accelerometers  which  makes  the  position  and  tilts  almost  perfect  for 
small  flight  durations  (i.e.  600  seconds). 


Scenario  one  Scenario  two 

(with  star  tracker)  (without  star  tracker) 


Figure  4.16;  Estimated  position  error  covariance  for  the  two  scenarios  for 
navigation  grade  INS. 
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Scenario  one 


(with  star  traeker) 


Seenario  two 
(without  star  traeker) 
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Figure  4.17;  Estimated  tilt  eovarianee  for  the  two  seenarios  for  navigation  grade  INS. 


Now,  we  inereased  the  aireraft  flight  time  from  600  seeonds  to  7200  seeonds  to 
see  the  effeet  of  using  star  traeker  on  the  navigation  grade  INS  for  long  flight  durations. 
Fig.  4.18  shows  the  estimated  position  error  eovarianee  for  the  two  seenarios  for  the 
navigation  grade  INS.  In  Fig.  4.13  we  see  a  very  good  improvement  when  the  star  traeker 
is  used,  as  seen  in  seenario  one.  The  estimated  position  error  eovarianee  deereased  from 
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6603m  to  3370m  in  the  x-axis  and  y-axis  when  star  tracker  is  used.  Also,  the  estimated 
tilts  covariance  for  the  two  scenarios  is  shown  in  Fig.  4.19.  In  Fig  4.19  we  see  an 
improvement  when  using  the  star  tracker  as  seen  in  scenario  one.  The  navigation  grade 
INS  decreased  to  5.8xlO“^rad  in  the  three  axes  when  using  the  star  tracker,  while  the 
estimated  tilt  covariance  is  5.9xl0“^rad  in  the  three  axes  when  the  star  tracker  is  not 
used. 


Scenario  one 
(with  star  tracker) 


Scenario  two 
(without  star  tracker) 
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Figure  4.18;  Estimated  position  error  covariance  for  the  two  scenarios  for 
navigation  grade  INS  for  7200  seconds  flight  time. 
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Scenario  one 
(with  star  tracker) 


Scenario  two 
(without  star  tracker) 


Figure  4.19;  Estimated  tilt  covariance  for  the  two  scenarios  for  navigation  grade 
INS. 


In  summary  of  this  section,  star  trackers  can  enhance  the  performance  of  all  the 
three  INS  grades  to  a  significant  improvement.  Table  4.4  shows  a  summary  of  the  results 
of  this  section. 
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Table  4.4:  Summary  of  final  error  standard  deviation  for  the  three  INS  grades  for 

both  scenarios 


Parameter 

(Units) 

Commercial 

Tactical 

Navigation  - 

•  7200  sec. 

Scenario  2 

Scenario  1 

Scenario  2 

Scenario  1 

Scenario  2 

Scenario  1 

Latitude  (m) 

12x10^ 

3606 

758 

201 

6603 

3370 

Longitude  {m) 

12x10^ 

3606 

758 

201 

6603 

3370 

Altitude  (m) 

4.2 

4.2 

4.2 

4.2 

10 

10 

{rad) 

0.93 

5.8x10“^ 

2x10“^ 

5x10-3 

5.9x10-3 

5.9x10-3 

£y  {rad) 

0.62 

5.8x10“^ 

2x10“^ 

5x10-3 

5.9x10-3 

5.9x10-3 

£z  {rad) 

1.74 

5.8x10“^ 

2x10-3 

5x10-3 

5.9x10-3 

5.9x10-3 

4,4  Impact  of  Star  Tracker  Accuracy  and  INS  Quality 

This  section  is  to  illustrate  the  impact  of  star  tracker  accuracy  on  different  INS 
grades.  The  Distance  Root  Mean  Square  (DRMS)  value  of  the  estimated  horizontal 
position  error  covariance  for  a  navigation  grade  INS  after  the  GPS  outage  is  simulated  for 
both  scenarios,  scenario  one  is  the  blue  line  (with  star  tracker)  and  scenario  two  is  the 
green  line  (without  star  tracker),  and  the  results  are  shown  in  Fig.  4.20. 

From  Fig.  4.20,  we  notice  there  is  no  effect  of  star  tracker  accuracy  on  the  second 
scenario  since  there  is  no  star  tracker  measurement  to  update  the  Kalman  filter.  For  the 
first  scenario,  the  star  tracker  is  continuously  updating  the  Kalman  filter  and  the  DRMS 
value  increases  when  the  star  tracker  accuracy  decreases.  Table  4.5  shows  the  difference 
of  the  DRMS  values  of  both  scenarios  for  the  navigation  grade  INS. 
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Figure  4.20;  Star  tracker  accuracy  effect  after  GPS  outage  for  both  scenarios  for 
navigation  grade  INS.  Scenario  one  is  the  blue  line  and  scenario  two  is  the  green  line. 


Table  4.5:  Improvement  in  DRMS  values  when  using  star  tracker  for  the  navigation 

grade  INS. 


DRMS  Improvement 

Star  tracker  accuracy 

After  5 
minutes 

After  10 
minutes 

After  30 
minutes 

After  60 
minutes 

0.1  arcseond 

1.64  m 

8.29  m 

127.09  m 

786.76  m 

10  arcseond 

1.16  m 

6.77  m 

119.19  m 

767.32  m 

200  arcseond 

0.03  m 

0.39  m 

30.76  m 

405.68  m 

1000  arcseond 

Om 

0.02  m 

2.38  m 

52.48  m 
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In  Table  4.5,  we  see  the  difference  of  the  DRMS  values  of  both  scenarios.  The 
difference  increases  when  the  GPS  is  not  available,  and  that  show  how  the  star  tracker 
improved  the  estimated  position  error  covariance  by  786.75m,  when  a  0.1  arcsecond  star 
accuracy  is  used.  Also,  we  notice  that  when  1000  arcsecond  star  tracker  accuracy  is  used 
there  is  not  much  effect  after  the  GPS  outage  occurred. 

Fig.  4.21  and  Fig.  4.22  show  the  DRMS  value  of  the  estimated  position  error 
covariance  for  scenario  one  for  the  tactical  and  commercial  grades  INS  respectively. 
Scenario  two  was  not  plotted  because  there  is  no  effect  of  the  star  tracker  on  it.  In  Fig. 
4.21  and  Fig.  4.22,  we  see  how  the  star  tracker  accuracy  effect  both  INS  grades,  and  as 
expected  when  the  star  tracker  accuracy  decreases  the  DRMS  value  increases. 


4,5  Chapter  Summary 

In  this  Chapter,  the  Kalman  filter  used  was  validated  for  all  the  three  INS  grades. 
Then,  performance  improvements  to  the  different  grades  of  INS  when  star  tracker  is  used 
were  shown  and  discussed.  Also,  the  impact  of  star  tracker  accuracy  on  the  INS  grades 
was  illustrated  and  discussed.  The  next  Chapter  will  discuss  the  research  conclusions  and 
the  future  work  recommendations  for  future  improvement  to  the  star  tracker  navigation 
technique. 
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After  5  minutes  After  10  minutes 


Figure  4.21:  Star  tracker  accuracy  effect  after  GPS  outage  for  scenario  one  for 

tactical  grade  INS. 
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Figure  4.22:  Star  tracker  accuracy  effect  after  GPS  outage  for  scenario  one  for 

commercial  grade  INS. 
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V.  Conclusion 


This  thesis  presents  a  simulation  for  integrated  star  traeker  and  inertial  sensors  for 
robust,  self-eontained,  autonomous  navigation.  In  this  ehapter,  eonelusions  about 
the  researeh  effort  are  presented  and  diseussed.  Also,  areas  for  future  researeh  work  are 
addressed. 


5,1  Conclusions 

The  goal  of  this  researeh  was  to  show  the  performanee  development  in  the 
different  types  of  INS  when  using  a  star  tracker.  The  star  tracker  was  used  as  an  aiding 
sensor  to  update  and  correct  the  orientation  of  the  vehicle’s  INS,  and  subsequently  to 
enhance  the  accuracy  of  position  and  velocity  of  the  vehicle. 

The  research  focused  on  two  scenarios,  these  two  scenarios  were  implemented 
with  three  grades  of  INS  commercial,  tactical,  and  navigation.  The  first  scenario  was 
about  using  the  GPS  for  a  small  period  in  the  beginning  of  the  vehicle’s  flight  time,  and 
then  it  stops  at  a  time  where  we  assumed  that  the  GPS  is  no  longer  available.  In  addition, 
the  star  tracker  and  barometer  were  available  in  the  first  scenario  for  the  total  vehicle’s 
flight  time.  The  second  scenario  was  similar  to  the  first  scenario,  but  instead  of  using  a 
star  tracker,  a  barometer  was  used.  These  two  scenarios  were  selected  to  show  the 
advantages  of  using  the  star  tracker  over  the  three  different  grades  of  INS. 

After  simulating  the  two  scenarios  with  the  three  grades  of  INS,  we  had  good 
results  that  show  the  performance  enhancement  in  the  INS  when  a  star  tracker  was  used. 


66 


The  star  tracker  was  able  to  enhance  the  position,  velocity,  and  tilts  of  all  three  grades  of 
INS.  The  enhancement  degree  changes  form  one  INS  grade  to  another  depending  on  the 
duration  of  the  vehicle’s  flight  time  and  the  accuracy  of  the  inertial  sensors  used  in  the 
three  INS  grades.  The  vehicle’s  flight  time  in  the  simulation  was  600  seconds,  and  the 
GPS  was  used  for  the  first  200  seconds. 

For  the  commercial  grade  INS,  the  star  tracker  was  able  to  correct  the  vehicle’s 
position  error  covariance  from  llxlO'^m  to  3600m,  which  is  a  tremendous  improvement 
to  the  position.  Also,  it  corrected  the  tilts  covariance  from  0.9rad  to  5.8xl0“^rad.  The 
star  tracker  showed  a  very  good  improvement  to  the  commercial  grade  INS.  Although  the 
final  accuracy  of  3600m  is  not  very  good. 

For  the  tactical  grade  INS,  the  star  tracker  was  able  to  correct  the  vehicle’s 
position  error  covariance  from  1000m  to  300m,  and  it  corrected  the  tilt  covariance  from 
2xl0“^rad  to  5.1xl0“^rad.  The  star  tracker  showed  a  very  good  improvement  to  the 
tactical  grade  INS,  on  the  600  seconds  time  interval. 

For  the  navigation  grade  INS,  the  simulation  was  carried  out  for  two  different 
vehicle’s  flight  time.  The  first  vehicle’s  flight  time  was  600  seconds,  and  the  star  tracker 
when  used  showed  very  little  improvement  to  the  navigation  grade  INS,  that  is  because 
the  navigation  grade  INS  uses  a  very  good  inertial  sensors  (i.e.  gyroscopes  and 
accelerometers),  and  the  vehicle’s  flight  time  was  small  for  the  inertial  sensors  biases  to 
increase  to  a  limit  where  the  star  tracker  can  make  a  difference.  So,  we  increased  the 
vehicle’s  flight  time  to  7200  seconds  and  made  the  GPS  available  for  the  first  200 
seconds.  In  this  situation,  the  position  error  covariance  of  the  navigation  grade  INS 
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decreased  from  6603m  to  3370m,  and  the  tilts  covariance  decreased  from  5.9xl0“^rad  to 
5.8x  10“^rad  when  the  star  tracker  was  used. 

In  conclusion,  the  star  tracker  was  able  to  improve  the  performance  of  the 
commercial  and  tactical  grades  INS,  for  any  duration  of  the  vehicle’s  flight  time.  Also, 
the  improvement  in  the  performance  of  the  navigation  grade  INS  was  not  significant  until 
the  vehicle’s  flight  time  was  more  than  approximately  1000  seconds. 


5,2  Future  Work  Recommendations 

This  research  has  covered  the  basic  simulation  for  using  star  tracker  and  the 
inertial  sensors,  and  the  following  points  can  improve  the  technique 

•  Study  the  relationship  between  stars  locations  and  the  vehicle’s  location. 

•  Build  a  realistic  star  tracker  measurement  model. 

•  Test  and  analyze  the  star  tracker  measurement  model  by  using  different  types  of 

Kalman  filter. 

The  first  point  in  my  recommendations  for  future  work  is  to  deeply  study  the 
relationship  between  the  stars  location  and  the  navigating  vehicle’s  location.  It  includes 
studying  the  stars  locations  in  space  and  how  can  we  benefit  from  knowing  stars 
locations,  and  how  can  we  transform  the  stars  locations  using  certain  reference  frames. 

The  second  recommendation  is  to  build  a  realistic  star  tracker  measurement 
model.  This  can  be  achieved  if  the  first  point  is  studied  deeply.  The  measurement  model 
will  include  the  Euler  angles  (i.e.  roll,  pitch,  and  yaw)  and  using  the  Euler  angles  as  an 
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update  measurement  to  the  Kalman  filter  ean  improve  the  vehiele’s  orientation  and  the 
INS  navigating  parameters. 

Using  a  realistie  star  traeker  measurement  model  will  enhanee  the  reality  of  the 
simulation  results.  Depending  on  the  star  traeker  measurement  model,  different  types  of 
Kalman  filter  eould  be  used,  sueh  as  an  Extended  Kalman  Filter  (EKE)  or  an  Unseented 
Kalman  Filter  (UKF).  It  would  be  useful  to  caleulating  the  improvements  to  the 
simulation  results  when  using  three  filters. 
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Appendix  A 


Al.l  1000  Monte  Carlo  Runs  Simulation,  Without  Measurements 

This  section  will  show  the  rest  of  the  INS  states  for  the  1000  Monte  Carlo  runs 
simulation  for  INS-only. 

A  1.1.1  Navigation  Grade  INS 


Time  (s) 


Figure  Al.l;  Velocity  ensemble  standard  deviation  and  mean  versus  filter 
computed  standard  deviation  for  navigation  grade  INS,  without  measurements. 
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Figure  A1 .2:  Tilt  ensemble  standard  deviation  and  mean  versus  filter  computed 
standard  deviation  for  navigation  grade  INS,  without  measurements. 
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Figure  A1 .3:  Accelerometer  ensemble  standard  deviation  and  mean  versus  filter 
computed  standard  deviation  for  navigation  grade  INS,  without  measurements. 
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Figure  A1 .4;  Gyroscope  ensemble  standard  deviation  and  mean  versus  filter 
computed  standard  deviation  for  navigation  grade  INS,  without  measurements. 
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Figure  A1 .5:  Barometer  ensemble  standard  deviation  and  mean  versus  filter 
computed  standard  deviation  for  navigation  grade  INS,  without  measurements. 
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Figure  A1 .6:  Velocity  ensemble  standard  deviation  and  mean  versus  filter 
computed  standard  deviation  for  tactical  grade  INS,  without  measurements. 
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Figure  A1 .7:  Tilt  ensemble  standard  deviation  and  mean  versus  filter  computed 

standard  deviation  for  tactical  grade  INS,  without  measurements. 
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Figure  A1 .8;  Accelerometer  ensemble  standard  deviation  and  mean  versus 
filter  computed  standard  deviation  for  tactical  grade  INS,  without  measurements. 
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Figure  A1 .9:  Gyroscope  ensemble  standard  deviation  and  mean  versus  filter 
computed  standard  deviation  for  tactical  grade  INS,  without  measurements. 
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Figure  A1 . 10;  Barometer  ensemble  standard  deviation  and  mean  versus  filter 
computed  standard  deviation  for  tactical  grade  INS,  without  measurements. 
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A  1.1. 3  Commercial  Grade  INS 
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Figure  A1 . 1 1 ;  Velocity  ensemble  standard  deviation  and  mean  versus  filter 
computed  standard  deviation  for  commercial  grade  INS,  without  measurements. 
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Figure  A.  12;  Tilt  ensemble  standard  deviation  and  mean  versus  filter  eomputed 
standard  deviation  for  commereial  grade  INS,  without  measurements. 
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Figure  A  1.13:  Accelerometer  ensemble  standard  deviation  and  mean  versus  filter 
computed  standard  deviation  for  commercial  grade  INS,  without  measurements. 
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Figure  A1.14:  Gyroscope  ensemble  standard  deviation  and  mean  versus  filter 
computed  standard  deviation  for  commercial  grade  INS,  without  measurements. 
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Figure  A  1.15;  Barometer  ensemble  standard  deviation  and  mean  versus  filter 
computed  standard  deviation  for  commercial  grade  INS,  without  measurements. 


84 


Z  Covarience  (m/s)  Y  Covarience  (m/s)  X  Covariance  (m/s) 


Al,2  Star  Tracker  Performance  Improvement  on  INS  Grades,  with  Measurements 


This  section  will  show  the  rest  of  the  INS  states  when  measurements  are  used  for 
the  two  scenarios. 
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Figure  A1 . 16;  Estimated  velocity  error  covariance  for  the  two  scenarios  for 
navigation  grade  INS. 
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Figure  A1 . 17;  Estimated  tilt  error  eovarianee  for  the  two  seenarios  for  navigation 
grade  INS. 
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Figure  A1 . 1 8;  Estimated  accelerometer  error  covariance  for  the  two  scenarios  for 
navigation  grade  INS. 
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Figure  A1 . 19:  Estimated  gyroscope  error  eovarianee  for  the  two  seenarios  for 
navigation  grade  INS. 
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Figure  A1 .20;  Estimated  barometer  error  covariance  for  the  two  scenarios  for 
navigation  grade  INS. 
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Figure  A1 .21 ;  Estimated  velocity  error  covariance  for  the  two  scenarios  for 
tactical  grade  INS. 
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Figure  A1 .22;  Estimated  tilt  error  covariance  for  the  two  scenarios  for  tactical 
grade  fNS. 
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Figure  A1.23:  Estimated  accelerometer  error  covariance  for  the  two  scenarios  for 
tactical  grade  INS. 
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Figure  A1.24;  Estimated  gyroscope  error  eovarianee  for  the  two  seenarios  for 
taetical  grade  INS. 
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Figure  A1 .25;  Estimated  barometer  error  eovarianee  for  the  two  seenarios  for 
taetieal  grade  INS. 
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A  1.2. 3  Commercial  Grade  INS 
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Figure  A1 .26;  Estimated  velocity  error  eovarianee  for  the  two  scenarios  for 
commercial  grade  INS. 
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Figure  A1 .27:  Estimated  tilt  error  eovarianee  for  the  two  seenarios  for 
commercial  grade  INS. 
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Figure  A1 .28;  Estimated  accelerometer  error  covariance  for  the  two  scenarios  for 
commercial  grade  INS. 
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Figure  A1.29;  Estimated  gyroscope  error  covariance  for  the  two  scenarios  for 
eommereial  grade  INS. 
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Figure  A1.30;  Estimated  barometer  error  covariance  for  the  two  seenarios  for 
eommereial  grade  INS. 
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